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Recently, research about trajectory tracking of autonomous vehicles has 
significantly contributed to the development of autonomous vehicle 
technology, particularly with novel control methods. However, tracking a 
curved trajectory is still a challenge for autonomous vehicles. This research 
proposes a state feedback linearization with observer feedback to overcome 
some difficulties arising from such a path. This approach suits a complex 
nonlinear system such as an autonomous vehicle. This method also has been 
compared with the linear-quadratic regulator (LQR) method. So, the goal of 
this research is to improve the control system performance of autonomous 
vehicles that are stable enough to navigate a curved path. Moreover, the 
study shows that the developed control law can track the curved path and 


Observer solve existing problems. However, improvements are still necessary for the 
State feedback linearization vehicle's performance and robustness. 
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1. INTRODUCTION 

Autonomous vehicle innovation has reached a milestone of achievements in the last few years. The 
control of a vehicle's motion is a critical part of autonomous vehicles, as it directly impacts the vehicle's 
safety and the satisfaction of its passengers. So, it is crucial to develop a path-following controller that 
overcomes problems in challenging environments [1]. 

The majority of current motion control research focuses on normal conditions. It is necessary to 
expand the research into difficult working conditions, such as curved paths, to achieve the promise of 
autonomous vehicles in managing crucial scenarios that human drivers find difficult or are unable to handle. 
Therefore, nonlinearity characteristics and multi-dimensional coupled dynamics are necessary to be improved 
under difficult operating conditions. Moreover, the requirements of system modeling, robustness, and 
adaptability of motion control algorithms are now much higher. In addition, research on the integration of 
motion planning and control which considers environmental parameters also is required to deal with multi- 
objective coordination in complicated scenarios [2]. So, research about tracking control is a demanding topic 
amount of other research topics on autonomous vehicle technology [3], [4]. 

Previous research on tracking control of autonomous vehicles using pure pursuit and stanley control 
shows satisfactory performance, especially in position control, and it has great benefits due to its simple 
design [5]. Park and Han [6] studied an adaptive pure pursuit controller to regulate the model, however, the 
data parameter is difficult to obtain and necessary to be reimplemented every time the platform is changed 
[7]. The study also demonstrates positive results for low-speed vehicle and linear road designs. However, this 
control approach cannot meet the requirements for driving on large road curvature and at high speed [5]. 
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Proportional integral derivative (PID) simplicity design is a tremendous advantage for engineering 
applications. PID is also familiar with tracking control problems [5]. However, its poor versatility and 
parameter tuning are unsuitable for dynamic systems and environments. Fuzzy PID is also used for 
autonomous vehicle control [8], [9]. Even though the simulation results show stable tracking performance, 
the system still requires optimization. However, the tuning process is more complicated. 

Linear-quadratic regulator (LQR) is a conventional optimal control approach, which develops an 
optimal controller using state feedback, this method is simple and frequently used in vehicle tracking control 
[5]. Hu et al. [10] developed an LQR control approach combining the future path's tangent direction and the 
heading angle. However, they still cannot ensure the system's stability when improving the path following 
task. Moreover, the LQR route tracking control approach based on visual road detection was also studied by 
Zhang and Zhu [11]. However, the research has not experimented with road tests [10]. Furthermore, some 
previous studies also have developed a less complex vehicle and presented control algorithms based on the 
LQR approach [6], [12], [13]. Therefore, a dynamic and a state space model were used to determine the LQR 
controller. So that improved vehicle performance can be reached while the vehicle is operated at a low speed 
on simple terrain. However, the controller’s effects significantly decrease because of linear feedback and 
model simplification when the vehicle performs nonlinearly due to modeling errors and disturbances. 
Therefore they added feedforward control based on road information [12], [14] and feedback control based 
on vehicle dynamics to the controller design [12]-[15]. However, this controller must be adjusted online, 
which requires powerful processing and the controllers' design depends on the linear assumption, which 
limits their use. 

The feedforward controller is developed based on feedforward data, i.e., road curvature and steering 
characteristics [5]. The autonomous vehicle has a large amount of I/O data. This large amount of data is used 
to develop model-free adaptive control to solve deviation angle tracking problems [16]. This approach has 
the benefit of a simple layout controller. However, this method is well-known as a black box, and it is not 
easy to analyze its stability and the high installation cost due to the expensive sensors [5]. 

Model predictive control (MPC) can cope with future prediction and system constraints in design 
development. It minimizes the error of the control design in a prediction horizon. Therefore, Sun et al. [17] 
introduced a new MPC control law and switched tracking errors. However, the approach only was 
experimented with in one path scenario [17]. The work conducted by Dai et al. [18] suggests an MPC 
controller and adaptive preview properties and a new longitudinal vehicle control. However, the speed 
control still cannot cope with the constraint. Furthermore, some previous researchers often simplified 
dynamics models and linearization to improve the efficiency of MPC. Therefore, some data are lost, and 
modeling errors occur during the design process. Thus, the vehicle cannot operate on large curvature roads 
and high-speed driving. This controller can generate steering control input and longitudinal tire force. 
However, this controller still necessary to be improved in real-time conditions, poor computation, and 
trajectory tracking stability analysis still require improvement [5]. 

Trajectory tracking using a state feedback linearization approach suitable for a class of nonlinear 
systems such as autonomous vehicles [19], [20]. This method is a popular approach among other control 
system design methods. The goal is to achieve good performance and stable conditions at the equilibrium 
[21], [22]. This approach also has a simple computation but is appropriate to apply in a highly nonlinear 
model, i.e., an autonomous vehicle [23]. Moreover, control algorithms for autonomous vehicles must meet 
the standard of safety and robustness, particularly in complex environments [23], [24]. 

Keeping the autonomous vehicle stable and robust in tracking predefined trajectories is essential in 
autonomous control system design. The real tracking field is sometimes hard to track, i.e., a curvature road. 
Drifting sometimes occurs when tracking a sharp bend at a high speed, so the vehicle requires to drive at a 
low speed when tracking this path [25]-[27]. The feedback linearization approach is appropriate to implement 
in a complex road scenario such as a curvature road because it considers all parameters and conditions from 
the system model and its environments to meet the requirement of a dynamic system's stable and robust 
condition [28], [29]. 

The benefit of the state feedback linearization approach using observer feedback is that it can 
overcome the unpredictable parameters and disturbances that typically result from nonlinear models, 
enhancing advantages and ensuring system stability. Observer feedback in this method could minimize the 
need for sensors naturally added to monitor these uncertain characteristics. The observer feedback can 
substitute these sensors in a complex system so that the system can limit the number of sensors that are used 
in the methods and simplify the architecture [30], [31]. Other approaches usually require many sensors to 
measure these parameters. 

Furthermore, this research goal is to meet the requirement of a stable and robust control system and 
apply theoretical control approaches such as state feedback linearization and observer feedback into 
autonomous vehicle technology. Therefore, the paper is prepared as follows; section 2 is about developing a 
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control law using the full-state feedback linearization approach and adding observer feedback to design new 
estimated states. In section 2, the full states feedback linearization with observer based on LQR is also 
designed for comparison. Section 3 discusses the research result of this method using the simulation software 
MATLAB. Finally, section 4 summarizes all the research progress and results. 


2. CONTROL LAW DESIGN 
2.1. State feedback linearization with observer feedback 

This research applies a state feedback linearization and an observer feedback approach for tracking 
control of the autonomous vehicle along curved path such as circular and sinusoidal paths. Observer feedback 
is designed to estimate more states from the model and optimize its system's output. So, the autonomous 
vehicle model chosen in this research is a kinematic model that represents motion regardless of the vehicle's 
dynamic components, such as force, torque, and inertia effects [32], [33]. The vehicle kinematic model is 
presented in Figure 1 as a two-dimensional coordinate (X-Y). Slipping and inertia parameters are not 
considered in this system [31]. The kinematic formula is represented as (1)-(3): 


x =v, cos 0 (1) 
ý =v, sind (2) 
6= tan x (3) 


Where (x,y) represents the vehicle position on the ground based on space coordinates, © £ (0,2 mm) is an 
azimuth angle that also corresponds to the vehicle position on the ground, and L is the length of the vehicle 
base. While the control inputs are u corresponds to the azimuth angle (©) and steering angle (a). This model 
is for low-speed and acceleration vehicles [32], [33]. 


X 


Figure 1. Vehicle model (top view) in 2D (X-Y coordinates) 


The vehicle kinematic model is transformed into state vectors, 1.e.: 


dq = |x,¥,6] (4) 
hy = (5) 
iy = v,cos0 = u(1) (6) 
n=» (7) 
ý, = v,sind = u(2) (8) 
6, = 6, (9) 
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6, = tana (10) 
Where vx corresponds to the vehicle's velocity, (X, Y) is the vehicle's position on the ground, © is the 


heading angle of the vehicle, L is the vehicle base’s length, and a is the vehicle's steering angle. Then, 
(5)-(10) can be transformed into a state vector form, such as (11)-(16): 


x =Ax+Bu (11) 
C=C x (12) 
y=Ay+Bu (13) 
C= Cy (14) 
6=AO0+Bu (15) 
Cg = CO (16) 


; o al. L a. Dilek Pilg 16 
wins = fejes flo = Gi): = Bile [eh 
_ fA]. , sO N.a sO). ,_ 
oS ak 4=[) ob@=[,pe=0 
Then, control feedback is designed to meet the control law requirement and consider the input reference such 
as (17): 
Uy = —K.X+% (17) 


K=[Ki, K2] is the state feedback matrix, and rx is the reference input. Design a characteristic equation with 
the desired overshoot and natural frequency, such as (18): 


p? + 20g,p + v2 = 0 (18) 


Where ø is overshoot and Q, is a natural frequency. 

The control law design is developed based on state feedback control method [32]. The state 
feedback gains are adjusted with this characteristic equation to reach stability around an equilibrium point. 
Then, observer feedback is added to this full-state feedback system, as represented in Figure 2. The new state 
vector is transformed to: 


‘| 3 k al A i [i]e+ pl? (19) 


p=y-[0 1] (20) 


Where C = [0 1], while £ corresponds to the state x estimation and D is the gain of the observer. This 
observer gain D must be observable to fulfill the system requirement. Assume the desired characteristic is 
given by: 


bq = 67 + 2tw,6 + w2 (21) 


Then, observer feedback D is computed to suit with desired overshoot (t = 0.5) and natural frequency 
(wn = 1), ie. 


det [AI — (A — D.C)] = 0 (22) 
A2+D1A+D2=62+65+4+1 (23) 


The actual coordinates (x,y) related to desired coordinates (Xa, ya) or reference input (rx) are described as (24) 
and (25): 


X= ig + kyXe (24) 
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Where kx and ky are controller gain: 
Xe = Xq 7X 
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(25) 


(26) 


(27) 


rx 
Y 
REFERENCE VEHICLE MODEL Cc o> 


X 
K OBSERVER 
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Figure 2. Control architecture of full state feedback linearization and observer feedback 


Transform (18) and (19) into a state matrix as (28): 
Xe k, 0 | Xe] _ 
K 4, E ie H =0 (28) 


The following Lyapunov function, which is positive definite [20], guarantees the stability of the system with 
a distinct equilibrium at the origin: 


1 


V =5e",e>0 (29) 
where 
os a (30) 
. ky, ] 
== 1 
é ky, Ye (31) 


and a derivative of Lyapunov function V is a negative definite [34], as (32): 
V = e". è =—k,x3 —kyy? < 0 (32) 


The error of this function converges to zero, and the system is asymptotically stable. The new controller 
computes a steering angle to enable the vehicle to track the desired course. 


2.2. Linear-quadratic regulator-based state variable feedback with full-observer design 

In this section an LQR-based state variable feedback with full-observer is designed as a comparison 
with the proposed method in subsection 2.1. Assume that the system in (11) is controllable and all the states 
can be identified. Set x and u to a minimal value: 


x™x > 0 (33) 

u'u > 0 (34) 
Both equations are always true, so the total cost function, 1.e.: 

J=(x'x +uTujdt (35) 
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Set some weighting Q and R to generalize function J, i.e.: 
J = (x7Qx + u” Ru)dt (36) 
Then minimize the cost function according to reference [35] until the Ricatti equation is achieved, i.e. 
ATP + PA PBR1B'P+Q=0 (37) 


The Ricatti equation can be solved numerically to find matrix P. 
Then design an observer based on LQR so that the (19) has an observer in the form: 


Ê = AR + But D(y — Cx) (38) 
So, the observer error is 

é=x-*#=(A—DC)e (39) 
While the control feedback using estimates states is: 

x = Ax — BK ĉ (40) 


So, the full state space feedback is: 


=P adk a) 
A-DC = AT —cTpT (42) 


So that the observer design feedback is: 
x= ATx+CTu (43) 


u = —Dx (44) 


3. SIMULATION RESULTS AND DISCUSSION 
3.1. Full state feedback linearization and observer 

An autonomous vehicle that tracks a linear and curved trajectory. The velocity is fixed at 10 m/s, 
starting at point (0,0) in X-Y coordinates. The trajectory control utilizes full state feedback linearization and 
observer. The simulation results as shown in Figures 3-5, which plots the actual trajectory and desired 
trajectory of a linear trajectory and curved trajectory. 


— desired trajectory | 
— actual trajectory 


Geographic Y Coordinates 
> 


0 5 10 15 20 25 30 35 40 45 50 
Geographic X Coordinates 


Figure 3. Linear trajectory tracking control using full state feedback and observer 


The actual trajectory has a slight error difference from the desired trajectory that approves the 
developed method. The goal of this approach is to put the desired poles in the stable space of the system. 
However, the system requirement should be controllable to achieve the desired condition so that the 
controllable system has the poles in the stability domain [32]. 
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Figure 4. Circular trajectory tracking control using full state feedback and observer 
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Figure 5. Sinusoidal trajectory tracking control using full state feedback and observer 


In this autonomous vehicle system, the overshoot is 0,5, and natural freqwency is 1, so the controller 
K is [1 1] and observer gain D is [1 1]. The vehicle is quite difficult to track the reference trajectory at a few 
seconds of the initial simulation time because the overshoot parameter had been set up. However, the vehicle 
response is stable according to the settling time setup. 

Therefore, the overshoot parameter is set as low as possible to suit the desired settling time 
parameter and to have a faster response. The chosen controller is adjusted with the model's desired response. 
Control performance depends on the desired overshoot, desired settling time, and chosen controller parameter. 

The ideal closed-loop control system has all states always available for feedback and a measurable 
process. However, only a few of the states of the system that available for feedback and measurement. So, the 
plan usually uses many sensors to read undetected states [32], which is expensive and complex. Therefore, 
this system designed an observer to reduce the number of sensors occupied. 

The system should be observable to meet the requirements of this approach. The desired 
characteristic response works in the stable domain. While the lateral error exists because of the design of 
settling time and overshoot, however, this model was fast enough to achieve stability. The model achieves 
stability after a few seconds in accordance with the desired settling time and overshoot design. The trajectory 
error is shown in Figure 6. The lateral error can be computed using the Lyapunov method, as represented in 
Figure 6. The lateral error is adjusted to asymptotically stable. Therefore, the error always converges to zero. 
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Figure 6. Trajectory error of sinusoidal trajectory 
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Moreover, Figure 7 represents the steering angle simulation results. The simulation result shows that 
at the initial condition, the controller tried to follow the predefined trajectory. However, the controller needs 
a few seconds to find the desired trajectory and reach stability. The steering angle is sinusoidal similar to the 
predefined trajectory because the steering angle tries to track the desired sinusidal trajectory. 


Steering Angles 
> 


L fi L fi 1 
0 10 20 30 40 50 60 70 80 90 100 
Time Variable 


Figure 7. The steering angle which is generated from the sinusoidal trajectory 


3.2. Linear-quadratic regulator-based state variable feedback with full-observer design 

This approach is similar to the full state feedback linearization method. However, the gain controller K 
and gain observer design are based on LQR. Therefore, we choose gain controller Kopimum=[1 1,7321] and gain 
observer Doptimum=[1,7321 1]. While, the gain controller and gain observer in the previous approach, is based on 
overshoot and natural frequency requirement. Figures 8-10 shows the simulation results of this LQR approach. 


— desired trajectory 
—— actual trajectory 
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Figure 8. Linear path trajectory based on full states feedback linearization with observer based on LQR 
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Figure 9. Sinusoidal path trajectory based on full states feedback linearization with observer LQR 


The simulation result shows that full states feedback linearization with observer based on LQR 
improves performance and achieves stability for the linear trajectory as represent in Figure 8. Linear 
trajectory eliminates nonlinearities in the system and transform the system into a linear system. However, this 
approach cannot apply in a nonlinear system such as a nonlinear vehicle, because LQR is designed only for a 
linear system based on a quadratic cost function. So that, this approach unable to reach stability for nonlinear 
system as shown in Figures 9 and 10. 
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Figure 10. Circular path trajectory based on full states feedback linearization with observer LQR 


The comparison Table 1 shows the comparison of the J cost function of both methods, state feedback 
linearization with observer and LQR. The comparison Table 1 shows that the state feedback linearization 
approach gives better results for a nonlinear system such as an autonomous vehicle due to its smaller J cost 
value compared with J cost function of the LQR. So, for a nonlinear system, a state feedback linearization is a 
better option than LQR. However, for a linear system, LQR gives better performance and optimization. 


Table 1. Comparison of J cost function from two proposed methods 
J cost values 
State feedback linearization State feedback linearization based on LQR 
Sinusoidal 4.5002 8.6541 
circle 8.1415 8.8673 


Input signal 


4. CONCLUSION 

This research proposed a trajectory tracking control for autonomous vehicles to track a curvature 
trajectory. The state feedback linearization and observer feedback are used to control the dynamic motion of 
the autonomous vehicle. The developed controller can control the model to navigate the desired trajectory. 
The simulation results show good vehicle tracking control performance and minimal lateral error. The LQR 
method cannot suit nonlinear systems such as vehicles due to its only design specific for linear systems. 

The state feedback linearization approach and observer feedback can measure many of the states to 
predict the uncertain parameters from the model. The technique generates a stable steering angle with 
minimum error. In the future, vehicle performance will be improved, particularly for driving in a complex 
path scenario. So, MPC can be the solution for such as problem. Combining this approach with a 
convolutional neural network will give better results for autonomous vehicle technology's control and 
computer vision. 
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